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Abstract —Motivated by the problem of formation control 
for vehicles moving at unit speed in three-dimensional space, 
we are led to models of gyroscopically interacting particles, 
which require the machinery of curves and frames to describe 
and analyze. A Lie group formulation arises naturally, and we 
discuss the general problem of determining (relative) equilibria 
for arbitrary G-invariant controls (where G = SE{ 3) is a 
symmetry group for the control law). We then present global 
convergence (and non-collision) results for specific two-vehicle 
interaction laws in three dimensions, which lead to specific 
formations (i.e., relative equilibria). Generalizations of the 
interaction laws to n vehicles is also discussed, and simulation 
results presented. 

I. Introduction 

This work is motivated by the problem of multi-vehicle 
formation (or swarm) control, e.g., for meter-scale UAVs 
(unmanned aerial vehicles), and builds on our earlier work on 
planar formation control laws [5], [6], [7] by extending the 
key results to the three-dimensional setting. Some objectives 
of our formation control laws are to avoid collisions between 
vehicles, maintain cohesiveness of the formation, be robust 
to loss of individuals, and scale favorably to large swarms. 

In considering the problem of multi-vehicle formation 
control, there is special significance, both practically and 
theoretically, to modeling the vehicles as point particles 
moving at a common (constant) speed. In the language of 
mechanics, the individual particles are subject to gyroscopic 
forces; i.e., forces which alter the direction of motion of 
the particles, but which leave their speed (and hence their 
kinetic energy) unchanged. A formation control law is then a 
feedback law which specifies these gyroscopic forces based 
on the positions and directions of motion of the particles. 
In the planar setting, gyroscopic forces serve as steering 
controls [6]. For particles moving in three dimensional space, 
we need to introduce the notion of framing of curves to 
describe the effects of gyroscopic forces on particle motion 
[ 1 ], [ 2 ]. 

Recently, a growing literature has emerged on planar 
formation control for unit-speed vehicles, using tools from 
dynamical systems theory (including pursuit models [9] and 
phase-coupled oscillator models [10]), as well as graph- 
theoretic methods [3]. An early (discrete-time) unit-speed 
model for biological flocking behavior is the Vicsek model 
[11]. Interacting particle models similar to those described in 
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this paper have also found application in obstacle avoidance 
and boundary following [ 12 ]. 

II. Curves and moving frames 

A single particle moving in three dimensional space traces 
out a trajectory 7 : [ 0 , 00 ) —> M 3 , which we assume to be at 
least twice continuously differentiable, satisfying | 7 '(s)| = 
1, Vs; i.e., s is the arc-length parameter of the curve (and the 
prime denotes differentiation with respect to s). The direction 
of motion of the particle at s is the unit tangent vector to the 
trajectory, T (s) = 7 '(s). If we further restrict the speed of 
particle motion to be unit speed, then the arclength parameter 
s is equivalent to time t , and T(t) =7 (t). The gyroscopic 
force vector always lies in the plane perpendicular to T, so 
to describe the effects of this force, we are compelled to 
introduce orthonormal unit vectors which span this normal 
plane. Taken together with T, these unit vectors constitute a 
framing of the curve 7 representing the particle trajectory. 

There are different framings one can choose, as is best 
illustrated by examples (see figure[l}. For a curve 7 (s) which 
is three times continuously differentiable, and for which 
7 // (s) 7 ^ 0 for all s , the Frenet-Serret frame (T,N,B) is 

uniquely defined, and satisfies 

V(«) = TOO, 

T'(s) = «00N00, 

N'OO = —k(s)T(s) + t(s)B(s), 

B'OO = —t(s)N(s). (1) 

In ©, N(s) is the unit normal vector to the curve 7 at s, 
and B(s) is the unit binormal vector (which completes the 
right-handed orthonormal frame). The curvature function n 
and the torsion function r are given by expressions involving 
the derivatives of 7 , and 7 "(s) 7 ^ 0 is required for r(s) to 
be well-defined. 

Although the Frenet-Serret frame for a curve (when it 
exists) has a special status (because it is uniquely defined 
by the derivatives of the curve), it is not the only choice of 
frame, nor is it necessarily the best choice. In particular, the 
requirement that 7 "(s) 7 ^ 0 presents serious difficulties for 
the interaction laws we consider in this paper. 

We therefore use an alternative framing of the curve 7 , 
the natural Frenet frame, which is also referred to as the 




Fig. 1. The Frenet-Serret frame (left), and natural Frenet frame (right), 
illustrated for a three-dimensional curve. 


Fermi-Walker frame or Relatively Parallel Adapted Frame 
(RPAF): 

V00 = T (s), 

T'(s) = k 1 (s)M 1 +k 2 {s)M 2 , 

Mi (a) = -fci(s)T(s), 

M' 2 (a) = -k 2 (s)T(s). (2) 

In 0, Mi(s) and M 2 (s) are unit normal vectors which 
(along with T(s)) complete a right-handed orthonormal 
frame. However, there is freedom in the choice of initial 
conditions Mi(0) and M2(0); once these are specified, the 
corresponding natural Frenet frame for a twice-continuously- 
differentiable curve 7 is unique. 

Both 0 and 0 can be packaged as control systems on 
the Lie group SE( 3), the group of rigid motions in three- 
dimensional space. (A modern reference for control systems 
on Lie groups is Jurdjevic [4].) Here we think of (k, r) or 
the natural curvatures (Aq, A^) as controls, which drive the 
evolution of the frame and the particle position 7. 

III. Formation model 

Figure 13 illustrates the trajectories of two vehicles moving 
at unit speed, and their respective natural Frenet frames. The 
particle (i.e., vehicle) positions are denoted by 17 and r2, 
and the frames by (xi,yi,zi) and (x2,y2,Z2)» so that 

iT=xi, 1*2 =x 2 , 

Xl = yiUi + Z1U1, X 2 = Y2U2 + Z2V2, 

yi = -xiiii, y 2 = -x 2 ^2, 

Zi = -X1U1, z 2 = -X 2 u 2 . ( 3 ) 

where the controls (u\,v\) and (1x2^2) may be feedback 

functions of the position and frame variables. 

We consider control laws which depend only on relative 
vehicle positions and orientations; i.e., which depend only 
on the shape of the formation. Furthermore, the effect of the 
controls on each trajectory is assumed to depend only on 



Fig. 2. Three-dimensional trajectories for two vehicles, and their respective 
frames. 


ri, r 2 , xi, and x 2 , and not on the orientation of the normal 
vectors within their respective normal planes. 

The controls for the first vehicle can then be functions 
of the relative vehicle position, r = r 2 — 17, the heading 
direction of the second vehicle, x 2 , and the frame variables 
for the first vehicle, (xi,yi,zi). Thus, 

= Mi(r,xi,yi,zi,x 2 ), 

Mi = Mi(r,xi,yi,zi,x 2 ), (4) 

and similarly, 

m 2 = M 2 (r,x 2 ,y 2 ,z 2 ,xi), 

V 2 = M 2 (r,x 2 ,y 2 ,z 2 ,xi). (5) 

Furthermore, because the overall motion of the first vehicle 
should be independent of yi and zi, we require 

Mi(r,xi,yi,zi,x 2 ) = Mi(r,xi,zi, -yi,x 2 ), (6) 

and similarly, 

*> 2 (r, x 2 , y 2 , z 2 , xi) = w 2 (r, x 2 , z 2 , -y 2 , xi). (7) 

Finally, we require that our control laws have a discrete 
(relabling) symmetry, which corresponds to the intuitive 
notion that both vehicles “run the same algorithm.” This 
implies 

Mi(—r,xi,yi,zi,x 2 ) = M 2 (r,x 2 ,y 2 ,z 2 ,xi), 

Mi(—r,xi,yi,zi,x 2 ) = M 2 (r,x 2 ,y 2 ,z 2 ,xi). (8) 

In this paper, the specific control laws we consider have the 




form 


To facilitate calculation, we define 


Ui = F(- r,xi,yi,x 2 ) - /(|r|) (-E • yij , 
u 2 = F( r,x 2 ,y 2 ,xi) - /(|r|) (|E • y 2 ^ , 
vi = F(- r,xi,zi,x 2 ) - /(|r|) (-E • , 

^2 = F( r,x 2 ,z 2 ,xi) - /(|r|) (|E • z 2 ^ , (9) 

which is a further restricted class of laws consistent with © 
- ©. (We discuss later how F and / are chosen.) 
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where ei = [ 1 0 0 ] T , 


IV. Shape variables and equilibria 

The geometry of the problem of interacting particles mov¬ 
ing at unit speed in the plane has been considered in earlier 
work [5], [ 6 ], [7]. The unit speed constraint leads to the study 
of gyroscopic interaction forces, and the identification of the 
constant kinetic energy hyper-surface with the group SE( 2 ) 
of rigid motions in the plane. Formations or steady patterns 
of motion in the plane thus become relative equilibria for 
particle dynamics on SE( 2 ) [5], [ 6 ], [7]. 

A key difficulty in extending the above geometric per¬ 
spective to three dimensions arises from the fact that the 
corresponding constant kinetic energy hyper-surface cannot 
be identified with SE( 3), the rigid motion group in three 
dimensions. It is a homogeneous space SE(3)/SO(2). How¬ 
ever, there is considerable advantage, particularly in the 
multi-particle context, to formulating the dynamics in terms 
of interacting particles in SE( 3). 

The dynamics 0 can be expressed in terms of the group 
variables gu g 2 G G = SE( 3) as a pair of left-invariant 
systems 

5i=5i£i, 92 =92^2, ( 10 ) 

where £ 1 , £2 G 0 = the Lie algebra of G. The dynamics for 
9 = 9 \ 1 92 are given by 

9 = -9i 1 9i9i 1 92 + 9i X 92 
= -9i l giiig + 9i l 92& 

= -£ 1 9 + 9& 

= 9t, (ID 
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and for any 3-vector T = (Ti,^,^), f is the skew- 
symmetric matrix defined by 
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Note that here we allow and VI 2 to each have the full 
three degrees of freedom - not just the two corresponding 
to the natural curvatures. The reason for proceeding in this 
manner is that ultimately we recover not only the relative 
equilibria of and m, but also an interesting class of 
relative periodic solutions for 0. 

From os we see that Q &2 = &iQ, from which it follows 
that 

fti = Qft 2 . (17) 

From is we also obtain Qe i = f^ib + ei. It can then be 
shown that w\ = W 2 , and u 2 -\-v 2 = u\ + v 2 . 

Introducing new variables w, a, and ^ 2 , we can 
express and ^2 as 
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If (for a 2 + w 2 7 ^ 0) we further define 


where £ = £2 - Ad p -ifi G g. 

Equation where £ incorporates the control inputs 

(^lj^i) and (u 2 ,V 2 ), describes the evolution of the relative 
position and relative natural Frenet frame orientation of 
the pair of vehicles. It is thus natural to consider what 
equilibria of <03 exist, and then to design control laws which 
stabilize those equilibria. Equilibria of the shape dynamics 
(03 correspond to relative equilibria of the system © on 
GxG. 

A. Shape equilibria for a two-particle system on SE(3) 

At an equilibrium shape g e of the shape dynamics <03, 
we have 

Se6(Se) =£l(Se)Se- (12) 
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where d G [0, 2i r) is arbitrary, we see that (flSl becomes 

% = Ga 2 + w 2 I%.Rle 3 , j = 1 , 2 , ( 21 ) 
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there is a corresponding reduced system on G (the “shape 
space”) given by 
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Note that R$, for arbitrary is a rotation matrix that fixes 
the basis vector e3. 

Defining b by b = R^R^b, after some calculation, one 
can show that 


( 1 ) 


(c.f. (E3J) whose equilibria are given by (fT4l» . Solutions of 
with 03, require that (fl8l hold. 

If w = a = 0, then Q satisfies Qei = ei, and b 
is arbitrary. Then Q yields one free parameter, and b 
yields three free parameters. 

If w 2 + a 2 7^ 0, then (Q,b) satisfies (l23l . with R^ 1 , 
R ^ 2 , it^, and given by (1201 and with b given by 
(l24l . The angle ip is related to w and a through ®, 
and $ and 63 are free parameters. 

The resulting (Q,b) then describe the shape equilibria (i.e., 
the relative equilibria) for (1281 ). 


( 2 ) 


(24) Proof: Follows from the calculations outlined above. □ 


Thus, g e can be decomposed as a product of five rigid mo¬ 
tions (four of which represent pure rotations), and contains 
two free parameters - and 63 - once the control vectors Di 
and 9l 2 are specified. 

Remark: For purposes of interpretation of in the context 
of particle trajectories, we may take R^ 1 = R^ 2 = /, so that 
G3 reduces to 
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To see this, recall that by definition g = g 1 1 g 2 . Let g e be 
defined by 


Thus, if we exhibit a shape equilibrium g e of the form 
CD, we can always write down a family of shape equilibria 
m parameterized by ^1 and f> 2 , which differ only in the 
orientation of the unit normal vectors of the two frames (and 
are therefore indistinguishable if only the particle trajectories 
in M 3 are observed). □ 

Proposition 1: Consider the two-particle system on G x G 
given by 


9 1 = 9 i 


where = Cli(g), = ^2(9), and g = g 1 l g2 (he., the 
controls Di and 9l 2 are arbitrary, but are G-invariant). Then 


Proposition 2: Consider (l28t as the underlying dynamics 
for the evolution of two particle trajectories in M 3 and their 
corresponding natural Frenet frames. Then relative equilibria 
(Q,b) for (l28l correspond to the following steady-state 
formations of the two particles in M 3 : 

(1) If w = a = 0, then the two particles move in the same 
direction with arbitrary relative positions. 

(2) If w = 0 but a ^ 0, then the particles move on circular 
orbits with a common radius, in planes perpendicular 
to a common axis. 

(3) If w 7^ 0 but a = 0, then the particles move in the same 
direction on collinear trajectories. 

(4) If w 0 and a / 0, then the particles follow circular 
helices with the same radius, pitch, axis, and axial 
direction of motion. 

Proof: Omitted due to space constraints, but follows from 
Proposition 1, along with the Remark and calculations 
outlined above. □ 

B. Shape equilibria for an n-particle system on SE(3) 

Our definition of the shape variable g for the two-particle 
problem extends naturally to the n-particle problem (under 
the assumption that the n-particle interaction law has G as 
a symmetry group). We define 


9 j — 9 i 9 j 5 


3 = 2, ■ 


(30) 


where gq, g 2 ,..., g n are the group variables (each representing 
one of the particles), and g 2 ,g3,...,g n are shape variables. 
(This is analogous to the approach taken in the planar 
problem, where the corresponding group is SE(2) [5], [6], 
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where ..., D n are G-invariant controls, as the underlying 
dynamics for the evolution of n particle trajectories in 
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Fig. 3. Rectilinear, circling, and helical formations, illustrated for five 
particles. The arrows represent the unit tangent vectors to the particle 
trajectories. 


M 3 . Then relative equilibria (Q 2 , b 2 ),(Q n , b n ) for (TTTI> 
correspond to the following steady-state formations of the n 
particles in M 3 (see figure 0 : 

(1) If w = a = 0 , then the n particles all move in the same 
direction with arbitrary relative positions. 

(2) If w = 0 but a^O, then the particles move on circular 
orbits with a common radius, in planes perpendicular 
to a common axis. 

(3) If w 7 ^ 0 but a = 0, then the particles move in the same 
direction on collinear trajectories. 

(4) If w ^ 0 and a / 0, then the particles follow circular 
helices with the same radius, pitch, axis, and axial 
direction of motion. 



Fig. 4. Convergence to a rectilinear formation (left), and to a circling 
formation (right). The trajectories, which are three-dimensional, are viewed 
perpendicular to the plane of the equilibrium formation. 



Fig. 5. An example of suitable functions /(•) and h(-) satisfying 
conditions (Al) and (A2) [6]. 


Proof: Omitted due to space constraints, but analogous to 

the proof of Proposition 2. □ function /(’) is 


Remark: When w / 0 at a relative equilibrium for our 
model (l28l> of particles evolving in G x G, the corresponding 
natural curvatures in 0 are then in fact periodic functions 
of time (or arc-length parameter). □ 

V. Rectilinear formation law 

The two types of equilibrium formations for which we 
consider specific stabilizing control laws (for a pair of 
vehicles) are rectilinear formations (in which both vehicles 
head in the same direction) and circling formations (in 
which both vehicles follow the same circular orbit). Figure 
|4] shows simulations which converge to these two types 
of equilibrium formations. For concreteness, we use the 
variables (ri,xi,yi) and (r 2 ,x 2 ,y 2 ), rather than the group 
variables g\ and g 2 . 

Consider the Lyapunov function candidate 

Vrect «~ln(l + X 2 • Xi) + /i(|r|), (32) 

where we assume that 

(Al) dh/dp = f(p), where f(p) is a Lipschitz continuous 
function on ( 0 , 00), so that h(p) is continuously differ¬ 
entiable on ( 0 , 00); 

(A2) lim p ^o h(p) = 00, lim^oo h(p) = 00, and 

3p such that h(p) = 0. 

Figure |3 shows an example of functions /(•) and h(-) sat¬ 
isfying conditions (Al) and (A2). An example of a suitable 
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where a and r Q are positive constants. Observe that the 
term — ln(l + X 2 • xi) in (l32l penalizes heading-direction 
misalignment between the two vehicles, and the term h( |r|) 
penalizes vehicle separations which are too large or too 
small. 

Differentiating V rect with respect to time along trajectories 
of 0 gives 


Vrect — 
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If we consider control laws of the form then m 
















becomes (after some calculation) 


V r , 


1 + X 2 ' Xl 

(xi • y 2 )F(r, x 2 ,y 2 ,xi) + (x 2 • yi)F(-r,xi,yi,x 2 ) 


+ (xi • z 2 )F(r,x 2 ,z 2 ,xi) + (x 2 • zi)F(—r,x 2 ,z 2 ,xi) . 

(35) 


It is clear from 03 that one choice of F which makes 
Vrect < Ois F(r,x 2 ,y 2 ,xi) = /zx r y 2 , where fj, = >u(|r|) > 
0. But more generally, we consider 


F(r, x 2 , y 2 ,xi) = =p? (^ • x 2 ^ (A • y 2 ^j + /xxi • y 2 , 

(36) 

where p and ij satisfy 

(A3) p(p) and rj(p) are Lipschitz continuous on (0,oo); 

(A4) /x(|r|) > \r){ |r|) > 0, V|r| > 0. 

(For simplicity, p and r] can be taken to be constants, rather 
than functions of |r|.) 

The control law given by Q with 03 is the natural 
generalization to three dimensions of the planar two-vehicle 
rectilinear law analyzed in [5], [ 6 ], [7]. As in the planar 
setting, we can interpret the terms involving / as steering the 
vehicles apart to avoid collisions (or steering them together 
into formation if they are too far apart). The terms involving 
p serve to align the vehicle headings, and the terms involving 
tj serve to align the vehicle headings perpendicular to (or 
parallel to) the baseline between the vehicles. 

The key to proving V rect < 0 rests with the inequality 
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which after some algebra can be shown to be equivalent to 


[l - (xi • x 2 ) 2 ] ± |(xi • x 2 ) 




—2 




> 0. (38) 


If xi = ±X 2 , then (l38l holds with equality for any choice 
of r. So suppose xi ^ ±X 2 , and consider minimizing the 
expression in © over all unit vectors r/|r|. It is not difficult 
to see that © achieves its minimum for some r/|r| lying 
in the unique plane P containing xi and X 2 (indeed, any 
component of r/|r| which is perpendicular to P will not 
contribute to expression ©.) Thus, © may be viewed as 


a planar inequality, and we can define angle variables 0i and 
02 such that 


Xl • x 2 = cos(0 2 - 0i), 




sin (j) 2 . 
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After substituting (l39l and applying some trigonometric 
identities, inequality © becomes 


sin (^ 2 - ) 


sin( 0 2 — 0 i) ± - (sin 20 2 — sin 20 i) 


> 0. 
(40) 


It can be shown that inequality © does indeed hold [5]. 


In the previous section, we defined shape variables in 
terms of group variables in SE( 3). However, for the two- 
vehicle problem at hand, we can use the variables (r, xi, X 2 ) 
instead, because equilibria of the (r,xi,X 2 ) dynamics will 
include all possible rectilinear formations. Note that V rec t 
depends only on (r,xi,X 2 ), as does V rect (due to the 
restrictions on the control laws we consider). Furthermore, 
the (r, xi, x 2 ) dynamics are self-contained as a result of ®- 

0. 


Proposition 4: Consider the system (r,xi,X 2 ) evolving on 
M 3 x S 2 x S 2 , where S 2 is the two-sphere, according to 
0 , 0 , and ®. In addition, assume (Al), (A2), (A3), and 
(A4). Define the set 


A = 


j(r,xi,x 2 ) 


x 2 • Xi 0 -1 and |r| 



(41) 


Then any trajectory starting in A converges to the set of 
equilibrium points for the (r, xi, x 2 )-dynamics. 

Proof: Observe that V rec t given by © is continuously 
differentiable on A. By assumption (A2) and the form of 
V rec t , we conclude that V rect is radially unbounded (i.e., 
V rec t —* 00 as Xi • x 2 —* — 1 , as |r| —> 0, or as |r| —> oo). 
Therefore, for each trajectory starting in A there exists a 
compact sublevel set D of V rec t such that the trajectory 
remains in Q for all future time. Then by LaSalle’s Invariance 
Principle [8], the trajectory converges to the largest invariant 
set M of the set E of all points in £2 where V rec t = 0. The 
set E in this case is the set of all points (r,xi,X2) £ ft 
such that X 2 = xi. Certainly if xi = X 2 = ±r/|r|, then 
u\ = U 2 = vi = V 2 = 0 and the trajectory remains in E for 
all future time. Similarly, if r-xi = r-X2 =0 and / (|r|) = 0, 
then u\ = U 2 = v\ = — 0 and the trajectory remains 

in E for all future time. Otherwise, we have the following 
expressions for the time-evolution of the quantities r • xi and 
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and the control law as 
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and similarly, 
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If xi ^ ±r/|r| and /(|r|) ^ 0, then ^(r-xi) ^ ^(r-x 2 ), 
and it follows that the trajectory leaves E. If /(|r|) =0, then 
the trajectory remains in E , but the only invariant subset of 
E with /(|r|) = 0 also has r • xi = 0 (or xi = =br/|r|). 
Therefore, the largest invariant set contained in E may be 
expressed as 


M = ( \ (r,xi,x 2 ) 
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x 2) 


Xl = x 2 = ± T 


nfi. 


(44) 


Clearly M is contained in the set of equilibria of the 
(r, xi, X2) -dynamics. To see that there are no other equilibria 
in £2, we observe that at equilibrium, r = X 2 — xi = 0, and 
hence X 2 = xi. Since at equilibrium, we must also have 
^(r • xi) = ^(r • X2) = 0, we see from equations (l42t 
and m that there are no equilibria in D apart from those 
contained in M. □ 

Remark: If / is given by 03 then /( |r|) = 0 is equivalent 
to | r | = r Q . Thus, the set of equilibria consists of formations 
with both vehicles heading in the same direction, and for one 
type of formation, the motion of the vehicles is perpendicular 
to the baseline between them with an intervehicle distance 
equal to r Q . For the other type of formation, both vehicles 
follow the same straight-line trajectory, with one leading 
the other by an arbitrary distance. The stability of these 
equilibria depend on the choice of parameters, and can be 
further analyzed using linearization. 

Remark: We can express V rect in terms of the group variable 
9 = fh 1 V 2 as 


Vrect = ~ ln(l + 511 ) + M r ), 


Ui = Tv(r) (^f 21 ) + v(r)92i + f(r) (^) , 

« = ww(^)+Kr)» 2 ‘ + /w(^), 

Vl = ^7](r) f 1/1 1’ 4 j + ^(r)s3i + f(r) (^) , 

(46, 

where g = g~ l = {g ij }, and r = + 5 m + 534- 

□ 


VI. Circling formation law 


Consider the Lyapunov function candidate 


Vdrc — 


1 x 2 • xi + 2 




where we assume 


MM), 

(47) 


(AT) dh/dp = f(p) — 2/p, where f(p) is a Lipschitz contin¬ 
uous function on (0, oo), so that h(p) is continuously 
differentiable on (0, oo); 
and (A2). It can be shown that 


1 - x 2 • X! + 2 ^ • x 2 ) ^ • x^ > 0, (48) 

and the function / given by <E3 can be used here, as well. 
The term h{ |r|) in (l47t penalizes vehicle separations which 
are two large or too small. The natural-log term in <E3 
involves the relative headings of the vehicles, as well as 
the relative orientations of the headings with respect to the 
baseline between the vehicles. 

Differentiating V circ along trajectories of m and plugging 
in <D gives 


Vcirc — 


l-x 2 -xi + 2 ( 1 = r -x 2 ) (^'Xi) 


-Xi • y 2 + 2 — • Xi 7 — • y 2 


x 2 -yi +2 — -x 2 7 — -yi 


-xi • z 2 + 2 — • xi 7 — • z 2 


•Zi 


-x 2 • zi + 2 ( 7 —- • x 2 


+’(r,x 2 ,y 2 ,xi) 

-F(-r,xi,yi,x 2 ) 

F(r,x 2 ,z 2 ,xi) 

F(-r,Xi,Zi,x 2 )|. 

(49) 


In place of J36l . we use 


F( r, x 2 ,y 2 , xi) = ± 7 ? ( — • x 2 


+M 


-xi • y 2 + 2 ( 7^7 • xi 


where we assume (A3) and (A4). 



(50) 


(45) 
































The key to proving V c i rc < 0 can then be shown to rest 
with the inequality 


1 - 


—x 2 • xi + 2 




2 


± 


x 2 • Xi 


> 0. 


-X 2 • Xi 




(51) 


Using a similar technique as was used above to pass from 
inequality m to inequality we can show that CD also 
becomes (essentially) inequality ©. 

Proposition 5: Consider the system (r,xi,x 2 ) evolving on 
M 3 x S 2 x S 2 , according to 0, Q, and d50b . In addition, 
assume (Al’), (A2), (A3), and (A4). Define the set 


A' = 


|(r,xi,x 2 ) 


1-X2 • Xi + 2 


and 





70 


(52) 


Then any trajectory starting in A' converges to the set 


M = 


/= ^|( r , x i 5 


x 2) 


x i = -X 2 , r-xi =0, /(|r|) 


U< (r,xi,x 2 ) 


x i = x 2 = ±rr \ ) n A'. 



Note that elements of M' with xi = — x 2 correspond to 
the two vehicles following the same circular orbit, separated 
by the diameter of the orbit, which is prescribed by the 
function /. Elements of M' with xi = x 2 correspond to 
rectilinear formations in which one vehicle leads the other 
by an arbitrary distance. 

Proof: Omitted due to space constraints, but a similar ap¬ 
proach is used as in the proof of Proposition 4. □ 

Remark: We can express V c i rc in terms of the group 
variables as 

Vcirc = -In ^1 - gu - 2^f—^ + h(r), (54) 

and the control law for circling can also be expressed in 
terms of the group variables, analogously to (l46l> . □ 

VII. Multi-vehicle formations 

One way to generalize the two-vehicle laws discussed 
above to n vehicles is to use an average of the pairwise 
interaction terms used for the two-vehicle problem [5], [6], 




Fig. 7. Simulation results for ten vehicles using generalization l55l of 
the two-vehicle circling formation control law £3 with 1501 and I33i . (The 
same simulation results are viewed from two different angles.) 


[7], i.e., 


= 

n f-' 


k^j 


F(rj - r*;,Xj,yj,Xfc) 

Yj - r k 


~f(\ r j — r fc|) 


l r i -r* 


•yj 


>j = -E 

n ^ 


k^j 


F(vj - r fe ,Xj,Zj,Xfc 


-/Oj - r fcl) 


r i - r fc 

l r i -Tfcl 


, (55) 


j = 1 In i55l . Yj is the position of the vehicle, 

(xj, y j , z j ) is the corresponding natural Frenet frame, and 
(uj,Vj) are the associated natural curvatures. Figures |6| and 
0 show simulation results for multi-vehicle interactions of 
this type. Their analysis is a topic of ongoing research. 
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